

// TurtleSquare.java
import gin.and.tonic.*;
import lejos.nxt.Button;

public class ball260
{

    private DragonRobot robot = new DragonRobot();
    int count=0;

    ball260()
    {
        UltrasonicSensor us = new UltrasonicSensor(SensorPort.S1);
        TouchSensor ts = new TouchSensor(SensorPort.S2);
        Motor arm = new Motor(MotorPort.A);
        robot.addPart(us);
        robot.addPart(ts);
        //us.addUltrasonicListener(this,20);
        //  ts.addTouchListener(this);
        arm.setSpeed(20);
        robot.addPart(arm);

        
        /*Mission ball&magnet*/
       // robot.setTurtleSpeed(60);
        robot.forward(700);//052111
        robot.left(10);
        arm.rotateTo(25,true);
        arm.rotateTo(-10,true);
        //arm.rotateTo(30,true);  //051611
       // robot.backward(10);//051611
        robot.right(60);//051611//45);
        arm.rotateTo(20,true);
        robot.forward(35);//051611 //55);
        robot.right(20);
        //robot.forward(20);
        arm.rotateTo(-60,true);
        arm.getMot().lock(60);
        //Tools.delay(1000);
        arm.rotateTo(40,true);
        robot.left(75);
        //arm.rotateTo(-80,true);
        robot.backward(800);
        robot.exit();
        Button.waitForPress();


    }

    public static void main(String[] args)
    {
        new ball260();
    }
}
